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AN APPROACH TO ATTITUDE DETERMINATION FOR 
A SPIN-STABILIZED SPACECRAFT (IMP I) 

by 

Ai Chun Fang 

Goddard Space Flight Center 


INTRODUCTION 

This report describes a simple technique for the determination of attitude of a spin-stabilized 
spacecraft. Use is made of telemetry data that provide information about two reference vectors and 
their relation to the spacecraft spin axis. This information indicates that the angle between the spin 
axis and each of the reference vectors can be obtained. Consider each of these angles as the half-angle 
of a cone whose axis coincides with the corresponding reference vector; then, the intersection of these 
two cones determines the position of the spin axis. If the spin axis is represented by its three direction 
cosines in an inertial coordinate system, two linear equations with three unknowns can be formulated. 
In order to solve this problem, an additional linear equation containing the same three unknowns is 
needed. The derivation of the third equation is based on the generation of a new unit vector that 
makes a known angle with the spin axis. The spacecraft attitude is then computed by solution of these 
three linear equations. An application of this technique, a determination of the attitude of IMP I, is 
illustrated in detail, and the associated FORTRAN program is presented. 

THE ATTITUDE DETERMINATION TECHNIQUE 

Mathematical Considerations 

Let the unit vector W (W x ,W 2 ,W 3 ) represent the spacecraft spin axis, and assume that 
PCPj , P 2 , P 3 ) and Q (Q x ,Q 2 ,Q 3 ) are two unit vectors with components known with respect to an 
inertial coordinate system. The inertial coordinate system employed is an earth-centered, right-handed, 
orthogonal system whose Z-axis coincides with the North Pole; the X , Y plane is the equatorial plane 
in which the X-axis passes through the vernal equinox. Consider the coordinate system x, y , z to be a 
spacecraft-centered coordinate system. If x, y, z are parallel to X, Y, Z, respectively, then the direction 
cosines of any vector in space are identical in both coordinate systems. 

Define the angles: 

jG = the angle (in radians) between W and P (0 < j3 < 7r) 

5 = the angle (in radians) between W and Q (0 < 5 < 7 r) . 
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If either (3 or 5 is equal to 0 or 7 r, the position of the spin axis in the inertial system is immediately 
known without further calculation. Therefore, only those cases for which both j3 and 5 are greater 
than 0 and less than n will be discussed. 

It should be noted that the angles (3 and 6 are quantities measured by sensors aboard the space- 
craft. Knowing (3 and 5, one can determine two possible orientations of the spin axis. Usually, the 
correct selection is made from a knowledge of the attitude control requirement. Figure 1 shows the 
relation of the spin axis W to the reference vectors P and Q. 

Since 


w 



Figure 1— The spin-axis vector W and the reference 
vectors P and Q. 


P • W = cos (3 , (1) 

the spin axis must be on a cone with axis P. Also, 
since 

Q • W = cos 5 , (2) 

the spin axis must lie on another cone with axis 
Q. The intersection of these two cones can be 
determined by solution of the following three 
equations: 

P x W { +P 2 W 2 +P 3 W 3 = cos (3 , (3) 

Q l W l + Q 2 W 2 +Q 3 W 3 = cos 8 , (4) 

W\ + W\ + W\ = 1 . (5) 


Because Equation 5 is nonlinear, it is obvious that solution of the above three equations will in- 
volve the solution of a quadratic equation in one of the three unknowns (W x , W 2 , or W 3 ). The prob- 
lem can be simplified if a third linear equation can be derived to replace Equation 5. The spin axis is 
then determined by the solution of three linear equations. 


The Attitude Determination Equations 


To obtain the third linear equation, first let 77 be the angle (in radians) between P and Q. Then, 
assume that the two vectors P and Q are not parallel (i.e., 0 < 77 < 7r), and define the unit vector 
V( V x , V 2 , V 3 ) perpendicular to both P and Q: 


V = — (P x Q) , 
sin rj 

therefore, 

1 sin 17 


( 6 ) 

(7a) 
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I 


^3^1 ^ 1^3 


y = - , 

(7b) 

L sm r\ 


^1 2 2 ” ^2^1 


V 3 = : • 

(7c) 

* sm 7} 


Let r be the angle between W and V. Then, 


V • W = cos r . 

(8) 


Equation 8 yields a third conical surface on which the spin axis must lie. (See Figure 2.) Applica- 
tion of spherical trigonometry to triangle ABC of Figure 3 yields 

cos i? = cos p cos 5 + sin p sin 5 cos a , 

by law of cosines; hence, by law of sines, 


Since 


Therefore, 


sm x = 


sin a sin p 
sin rj 


sin x = cos X' , 

. sin a sin P 

cos X = 

sin T) 

cos r = sin 5 cos X' 


sin a sin )3 sin 5 
sin tj 

Consequently, W l , W 2 , and W 3 are determined by the following three equations: 


P X W X +P 2 W 2 + P 3 W 3 = cos P , 
Q 1 W 1 +Q 2 W 2 +Q 3 W 3 =cosS , 
V x W x + V 2 W 2 + V 3 W 3 = cos t . 


In matrix form, Equation 10 becomes 



(9) 


OO) 


( 11 ) 
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Define the determinant A by 


A = 


G, 


v t 


1 2 r 3 

Q 2 Gq 


Since 

A = sin rj 

*0, 

the matrix is nonsingular and possesses an inverse. Therefore, 

a, 

"'•-A 


"'•■T 


where 




w 3 = T 


cos j3 P 2 
cos 5 Q 2 
cos r F. 
P 


*2 = 


1 


A 3 = 


2 

cos |3 
cos 5 


K, 


e 3 

COS T V 3 

P 2 cos j3 

(3, cos 5 


F 2 cos t 


( 12 ) 


If |W 3 | = 1 , the spin axis points toward either the North Pole or the South Pole. For \W 3 \ =£ 1 , the 
right ascension R s and declination D of the spin axis are 


i W > 

R = tan" 1 — 
s W l 


D s = sin 1 W 3 . 


( 13 ) 
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The Reference Vectors 


Two sensing instruments are required for the measurement of (3 and 5. At present, several types 
of sensors have been developed for this purpose. Among them are the sun sensor, for measuring the 
angle between the spin axis W and the sun position unit vector S; the earth-horizon sensor, which pro- 
vides the angle between W and the downward local vertical unit vector L; and the magnetometer, which 
provides the angle between W and the geomagnetic field unit M. If the spacecraft possesses these three 
types of sensing instruments, then P and Q can represent any two nonparallel vectors chosen from S, 

L, and M. 

However, because of limited space, most spacecraft contain only two types of sensors. Hence, 
the information given can provide only two of the vectors to be used instead of three. For instance, 
if a sun sensor and a magnetometer are the two instruments aboard the spacecraft capable of measuring 
j3 and 5, then the sun position unit vector S and geomagnetic field unit M should be represented. 

Let 

SL = the angular distance of the sun from the vernal equinox, measured eastward in the ecliptic 
plane (see Figure 4), 

i = the inclination of the ecliptic to the Equator. 

The right ascension oc $ and the declination 5^ of the sun can be obtained from 

tan o t = cos i tan SL 

sin 8 s = sin / sin SL . 



Figure 4— The sun position vector. 
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The components of the sun position vector S are 

S x = cos 8 S cos a s , 

S y = cos 5 S sin a s , 

S, = sin 5 C . 

Since P = S, we have Py = S X ,P 2 = S 1 , and P 3 = S z . 

If the sun sensor happens to be the only type of sensor providing information, the spacecraft 
attitude cannot be determined from a single spacecraft telemetry readout. However, if the spin axis 
changes only slightly, its orientation can be estimated by solution of Equations 1 0 with P as the sun 
position vector at time T 1 and Q as the sun position vector at a different time T 2 , where T i and T 2 
are days. 

The spacecraft position unit vector R is known from orbit determination. If Sy , S 2 , and S 3 are 
the three direction cosines of the vector R at the time when the magnetometer makes the measure- 
ments (see Figure 5), then 

L = -R, 

COS 0 ~ , 5 

y/s\+s\ 

s in o = ~ , 

s/sf^s l 

cos v = S 3 , 

sin v ~\Js\ + . 

Let B x ,B y , and B z be the components along the body axes of the earth’s magnetic field measured 
by the magnetometer. If the spacecraft spin axis is designed to coincide with the body z-axis, the angle 
5 between the spin axis and the earth’s magnetic field is given by 

5 = cos 1 — — — — . 

Since the position of the spacecraft is known, a local coordinate system with its origin 0 / at that 
position can be defined. In this system, the Xj-axis points north, the j^-axis points east, and the 
z ; -axis points down along the local vertical. (See Figure 6.) At the point O t , the direction cosines 
M n , M e , My of the field vector M in the x t , y { , system can be derived from actual knowledge of 
the field.* The components of M in the geocentric inertial coordinate system can therefore be 
obtained by the use of a coordinate transformation. 

*Cain, Joseph C., Hendricks, Shirley, Daniels, Walter E., and Jensen, Duane C., “Computation of the Main Geomagnetic Field From 
Spherical Harmonic Expansion,” GSFC Data User’s Note, NSSDC 68-11, May 1968. 
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z 


z 




Figure 6— The x jf y f/ and z f axes of the local 
coordinate system. 


The first part of the transformation is a rotation (it - v) about the .fy-axis through an angle 
7T - v. The second part is a rotation R z (-a) about the displaced Zj-axis through an angle (-a). These 
two rotations bring the x l9 y l9 z x axes parallel to the X 5 7, Z axes, respectively. The matrices for these 
two rotations are 


Ry Or - v) = 



0 

1 

0 



R 2 (-<t) = 



-sin o 
cos CT 
0 



Therefore, the transformation to obtain the direction cosines of M in the inertial coordinate system 
may be written as 



8 



Thus, Q l = M x , Q 2 = M 2 , and Q 3 = M 3 . However, if an earth-horizon scanner is used instead of the 
magnetometer, then we would have Q x = , Q 2 = -S 2 , and 0 3 = -S 3 . 

ANALYSIS OF THE IMP I DATA 


Sensor Data 


The IMP I onboard attitude determination system consists of a sun sensor and an earth-horizon 
scanner. The sun sensor measures the angle j 8 between the spin axis W and the sun position unit 
vector P and triggers a counter that records the time T s between successive sun pulses. Values of T s 
are the spin periods SP. It is to be understood that the spin period cannot be determined when the 
spacecraft enters earth’s shadow. 

The horizon scanner is mounted at an angle 7 from the spin axis of the spacecraft. As the space- 
craft rotates, it scans a cone of half-angle 7 . (For IMP I, 7 ^ 7t/2 radians.) During each rotation, the 
scan may intersect earth. Let E. be the point where the scan cone enters the sunlit earth disk and E q 
be the point where it leaves the sunlit earth disk. (See Figure 7.) At E. and E Q , the discontinuity 
between the bright earth disk and the dark background will cause the sensor to produce a positive out- 
put pulse. If 77 and T Q represent, respectively, the times at which the E { and E q pulses are produced 
with respect to the previous sun pulse, the earth width p is defined by 


A 



Figure 7— Case I : Full sunlit earth. 


27 r 

" =tew s- 


(14) 


where 

TEW =T o ~ T. . 


During the time interval 7\, the spacecraft will 
rotate through an angle 6 measured about the 
spin axis: 


d = 


2n 
T. — 
‘ SP 


(15) 


The values of TEW and T. are telemetered to 
earth and used in the calculation of the nadir 
angle 5, the angle between the spin axis and the 
vector L from the spacecraft to the center of 
earth. If p is one-half the angle subtended by 
earth at the spacecraft position, then it is 


9 



II 


obvious that any telemetry data processing one or more of the following conditions should be 
rejected: 

P<0, ' 


0 >», > 
M > 2p . ) 


(16) 


The half-angle p is given by the equation: 


sinp = 


R e +h ’ 


(17) 


where R is the radius of earth and h is the altitude of the spacecraft orbit. 

Since a portion of earth is always dark, a fully illuminated disk may not always be seen by the 
spacecraft; hence, it is necessary to determine the visibility of the terminator and the sunlit earth hori- 
zon before the nadir angle is computed. The situation will be either (1) that both E ( and E Q are at the 
sunlit horizon (double horizon crossing) or (2) that one of them is at the sunlit earth horizon (single 
horizon crossing) while the other is at the terminator (terminator crossing). 


Determination of Crossings 

For the determination of the crossings, the inertial coordinate system will be used. The cosine of 
the angle < p between the sun and the spacecraft is 

cos ip = S x S l +S y S 2 +S Z S 3 . (18) 

A comparison between the angles <p and p is required. If 

cosp>cosp, (19) 

the spacecraft is in sunlight, and the fully illuminated earth is seen (i.e., both E. and E 0 are sunlit hori- 
zon crossings). If 

- cos p < cos <p < cos p , (20) 

the spacecraft is in sunlight, and the terminator is visible. Therefore, one of the crossings is a termina- 
tor crossing. Unfortunately, the terminator data are not useful in the calculation of the nadir angle 
and are rejected. Only when the horizon is sunlit are the data acceptable. 

The determination of the sunlit crossing horizon depends upon the rotation angle of the space- 
craft 6. If 8 < 7r, E t is at the sunlit horizon. This is because the sun position vector and the vector 
from earth’s center to E. form an acute angle. If 6 > n, then E Q is at the sunlit horizon. If 

cos <p < - cos p , (21) 

the spacecraft is in earth’s shadow, and the data are rejected. 
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Computation of the Nadir Angle 5 

Two different techniques are used to obtain 5: one for the case of a fully sunlit earth and the 
other for the case when the terminator is visible. For both cases, the coordinate system centered at the 
spacecraft will be employed. 


Case I: Solution Procedure for 6 When Earth Is Fully Visible 


Consider the planes WE , WE r and WE o that are defined by the vector W and the points E, E., 
and E q , respectively. The angle between the planes WE { and WE is p. If the spacecraft is spinning 
without precession, the plane WE bisects p . Thus, the angle 8 is related to the measured angles p and 
p, as can be seen by application of the law of cosines to the spherical triangle AE ( E\ 


cos p = cos 7 cos 6 + sin 7 sin 5 cos — , 


smce 


sin 2 5 = 1- cos 2 5 . 

If 7 = 7t/2, it follows from Equation 22 that 


5 = sin 1 


cos p 
cos p/2 


( 22 ) 

(23) 

(24) 


For 7 =£ 7r/2, Equations 22 and 23 can be solved for cos 5. However, another equation in 5 can be 
obtained if the law of cosines is applied to the spherical triangle ASE: 


cos 77 = cos P cos 6 + sin P sin 5 cos 


B) 


(25) 


Therefore, for 7 ¥= n/2, Equations 23 and 25 can also be used to evaluate cos 6. 

It should be noted that Equations 22 and 25 are linear in sin 5 and cos 5. Therefore, one can 
obtain 5 by simply solving these two equations simultaneously: 


sin 6 = 


cos P cos p - cos 7 cos 77 
ft ~ 


cos 5 = 


cos 77 sin 7 cos p/2 - cos p sin P cos ( 6 + p/2) 

- — " 


(26) 

(27) 


where 


we have 


(0+2)*°, 

cos /3 cos p - cos 7 C OS T? 

cos 77 sin 7 cos p/2 - cos p sin /? cos (0 + p/2) 


SI = cos (3 sin 7 cos — - sin 0 cos 7 cos 


5 = tan 1 


(28) 
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Equation 28 will satisfy Equation 23 if there are no errors in the values of measured quantities. 
However, the values of the measured quantities j 3, p, 6, and ju will contain errors, and the measurement 
errors in p and p might be different from those in /3 and 6. Consequently, the solution of Equations 
22 and 23 might not satisfy Equation 25 (or the solution of Equations 23 and 25 might not satisfy 
Equation 22). In other words, even with identical input data, the final attitude solutions are expected 
to have slightly different values if the equations being used in the computations are not exactly the 
same. 

Case II: Solution Procedure for S When the Terminator Is Visible 

If the spacecraft is in a position where the terminator is visible, the angle p is no longer bisected 
by the plane WE, and the Case I method cannot be employed for the determination of 5. Therefore, 
another method will be developed for this situation. 

Suppose that 0 < 6 < 7r and that the point E. is at the sunlit horizon. Let ITS 1 be the plane con- 
taining the spin axis and the sun. Define a horizon plane WE. (a plane containing both the spin axis 
and a point on the sunlit horizon). If 0 is defined as the smaller of the two angles between planes H4S' 
and WE t , then 

0 = 0. (29) 

If A and 17 are two great circle arcs extending from the sun S to the points E. and E, respectively (see 
Figure 8), then 

cos A = cos ft cos 7 + sin j3 sin 7 cos 0 . (30) 

The value of A must satisfy the following condition: 

77-p<A<0, (31) 

where 0 is the hypotenuse of the right spherical triangle SEC, which has legs p and 77. (See Figure 9.) 
The value of 0 is determined by the equation 

cos 0 = cos p cos r? . (32) 


s 


D 


Figure 9— Range of A and e. 




A 



Figure 8— Case II: Terminator visible. 
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The angle £ between arcs /3 and X of the spherical triangle SE { A in Figure 8 can be found by 
application of the law of sines: 


sin £ = 


sin 0 sin 7 
sin X 


( 33 ) 


where 


0<£<tt. 


Next, the angle e between arc X and 17 of the spherical triangle SE ( E is evaluated by the use of the 
equation 

cos p - cos X cos 77 


cos e = 


Since 
we have 


sin X sin 77 
|cos X| < 1 
cos p > COS 77 . 


(34) 


Hence, the value of cos e determined by Equation 34 can never be negative. The range of e is 

0 < e < k . (35) 

This can be seen in Figure 9, which shows that the arc SG of the right spherical triangle SGE is tangent 
to earth. The angle k is obtained by the use of the equation 


_ 1 sin P 

k - sin 1 

sin 77 


(36) 


The computed values of the angles X and e must satisfy Equations 31 and 35, respectively, or the data 
are rejected, and no further computations are made with them. 


The nadir angle 5 is determined by the following equations: 

cos 6 = cos j8 cos 77 + sin j3 cos (£ + e) sin 77 (for e not included in £— see Figure 8) 

cos 5 = cos )3 cos 77 + sin j3 cos (£ - e) sin 77 (for e included in £— see Figure 10). 

The range of 5 is 


(37) 

(38) 


7~p<S<7 + p. (39) 

When 6 is in the range n <6 < 2n, E Q , where the scanning cone crosses the sunlit horizon, becomes the 
point of interest. The horizon plane in this case would be WE Q , and the viewing angle <p is given by 

0 = 27r - (0 + p) . (40) 

The solution procedure for this case is similar to that already presented and will not be covered here. 

Once the nadir angle 5 is known, the attitude of the spacecraft can be determined with the aid 
of the technique described in the first section of this paper. 


13 


A 



Figure 10— Case II, when e is included in f. 


FORTRAN PROGRAM* 

Subroutine SPIN 

Based on the analysis developed in this re- 
port, a FORTRAN subroutine, SPIN, was devel- 
oped for the computation of the components of 
the spin axis. The FORTRAN listing of this 
subroutine is given in Appendix B. The sub- 
routine is referenced by the following statement: 

CALL SPIN (P, Q, BETA, DETA, W, U, IN) , 
where the input variables are 

P = reference vector with components 
P(1),P(2),P(3), 

Q = reference vector with components 
Q(l), Q(2), Q(3), 

BETA = angle /3, between spin axis and vec- 
tor P, 

DETA = angle 5, between spin axis and vec- 
tor Q, 


and the output parameters are 

W = spin-axis orientation vector with components W(l), W(2), W(3), 
U = spin-axis orientation vector with components U(l), U(2), U(3), 


IN = 0, if the spacecraft attitude cannot be determined, 

= 1, if there is only one solution W for the spin-axis orientation [the components W(l), W(2), 
W(3) of W are computed] , 

= 2, if there is another solution U in addition to W for the spin-axis orientation [the compo- 
nents U(l), U(2), U(3) of U are computed] . 

Generally, there will be more than one attitude solution. The correct solution will be chosen by means 
of a comparison with an a priori estimate of spin-axis orientation. The solution that is closest to the 
estimate is chosen. 


The main program provides— 

(1) The input parameters P, Q, BETA, and DETA before the subroutine SPIN is called 

(2) Right ascension and declination, if they are desired, after subroutine SPIN is called when 
IN # 0 and |W(3)| =£ 1 [and/or |U(3)| # 1 if IN = 2] 


*See Appendix A for a list of the FORTRAN symbols. 
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(3) The correct solution for the spin-axis orientation when IN = 2 

Attitude Data Reduction and Attitude Determination for IMP I 

For the spin-stabilized spacecraft IMP I, a FORTRAN program is used to reduce the input attitude 
data and compute the nadir angle. The subroutine SPIN (P, Q, BETA, DETA, W, U, IN) is then called 
to determine the spacecraft attitude. Since the telemetry data obtained from IMP I are quite abundant, 
it is necessary to select suitable values for the input. In the implementation of this selection procedure, 
several conditions are imposed that test the available telemetry data. All data that fail to satisfy these 
conditions would yield spurious attitude solutions and are therefore rejected. The FORTRAN program 
listing given in Appendix C is intended to conserve computer time and provide the correct spin-axis 
orientation. The input parameters are 

Card deck 1 : ID, IDAY, IH, IM, IMS, IET, IEW, SPP, BETAD 

FORMAT (11,14, 213, 16, 5X, 215, 5X, 2F8.2) 

Card deck 2: SP, SQ, ST, SX, SY, SZ 

FORMAT (13X, 3F12.3, 3F10.7) , 

where 


BETAD = angle between W and P (degrees), 

ID = option for control to read the input card deck (when ID = 0, the attitude 
data are read continuously until ID =£ 0, 

IDAY, IH, IM, IMS = time (days, hours, minutes, and seconds, respectively), 

IET = time of occurrence of -pulse with respect to previous sun pulse, 

IEW = time between E. and E pulses, 

SPP = spin period of the spacecraft, 

SP, SQ, ST = components of spacecraft position vector, 

SX, SY, SZ = components of sun position unit vector. 

The output parameters are the components of all attitude solutions together with the right ascension 
and decimation of the selected spin-axis orientation. A sample of the output is shown in Appendix D. 

CONCLUSION 

This report has demonstrated how telemetry data from IMP I are used in a determination of the 
attitude of that spacecraft. The technique can be applied to any spin-stabilized spacecraft having any 
two of the following three instruments aboard: sun sensor, magnetometer, and earth-horizon sensor. 
Examples of such spacecraft would include ISIS 1 and SSS 1 . 
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Appendix A 



FORTRAN Symbols 

Mathematical Symbol 


FORTRAN Symbol 

R e 


RE 

7 (degrees) 


GAMAD 

sin 7 


SGAMA 

cos 7 


CGAMA 

fj. (degrees) 


EW 

cos fx/2 


CEW 

(3 (degrees) 


BETAD 

j3 (radians) 


BETA 

sin |3 


SB 

cos (3 


CB 

0 (degrees) 


ET 

cos (6 + n/2) 


CETWH 

p (radians) 


ROM 

sin p 


SR 

cos p 


CR 

sin <p 


SA 

cos <p 


CA 

77 (degrees) 


ETA 

sin 77 


SE 

cos 77 


CE 

\l/ (degrees) 


XD 

COS \jj 

1 . 

17 

CKX 


Mathematical Symbol 


FORTRAN Symbol 


5 (radians) 

DETA 

sin 5 

SDTA 

X (degrees) 

CKD1 

sin X 

SKI 

cos X 

CK1 

e (degrees) 

EK1 

Cl 

DNUM 

cos e 

CEK1 

k (degrees) 

SED 

£ (degrees) 

BK 

sin £ 

SBK 

COS i p 

CSES 

(degrees) 

SESD 

cos r 

CETA 

cos a 

FA 

A 

DTA 

A i 

DTI 

A 2 

DT2 

*3 

DT3 
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Appendix B 


FORTRAN Listing of Subroutine Spin 

SUBROUTINE SP I N t P , 0 , BET A , DETA.W.U.IN) 

C 

C • IF 1N*0, 

C • 

c 

C • IF IN-1 

C 

C * IF IN-2 

C 
C 
C 

dimension p ( 3 ) ,Q < 3 > ,w ( 3 » ,u ( 3 ) 

DIMENSION A ( 3 ) ,B<3) , C C 3 ) ,0(3) ,V(3I 
50 FORMAT ( 2 X , 6F |2,8) 

C ER IS THE ERROR LiMIT WHICH CAN BE MODIFIED, 

ER-0. 00001 
C 

l N- 1 

SBETA-S I N (BET A ) 

CBETA=COS ( BETA ) 

IFISBETA. LE.ER) Go to too 
SDET A-S I N ( DET A ) 

CDETA = COS ( DET A ) 

I F ( SOET A .LE .ER ) Go TO 1 *4 0 
C 

CGEMA=P( 1 )*Q( 1 )+P(2)*Q(?)+P(3I*Q(3) 

ACMA.ABS ( CGEMA ) 

I F ( A C M A ,GE, 1.0) GO TO 180 
GEMA*(ACOS(cGEMA> 1/0.0)745329 
SGEMA»SQRT(1,0-CGEMA*CGEMA) 

PRINT 52 , GEM A 

5? F0RMATI2X,* ANGLE between TWO GIVEN VECTORS P and Q ARE* , F 1 2 • 5 ) 

c 

IF ( » 1 ,0-ACMA ) .LE.ER ) GO TO 200 
AD-COS ( BETA+DETA ) 

IF (AD. GT. CGEMA ) Go TO 55 
IF( (CGEMA-AD) .LE.ER) GO TO 65 
C 

FA»(CGEMA-CBETA*CnETA)/(SBETA*SDEfA) 

IF < ABS (FA > .GT . 1 .0 ) GO TO 60 
CETA-(SQRT(1,0-FA.FA))#SBETA*SDETA/SGEMA 
I F ( ABS ( CETA ) .LE .Er ) GO TO 65 
GO TO 78 
C 


THERE is NO SOLUTION FOR ATTITUDE DETERMINATION 
EITHER BECAUSE P IS PARALLEL TO 0 OR BECAUSE THERE 
is error in measurement 

ONE SOLUTION FOR SPIN AXIS OR I E nT A T I ON , T HE COMPONENTS 

of spin axis vh i i ,w(2> ,and w<3) are then computed. 

TWO SOLUTIONS FOR SPIN AXIS ORlFMTATlON . THE SECOND 
SET OF COMPONENTS U I l ) ,U ( 2 ) , AND U<3) ARE COMPUTED 

in addition to the first set w< 7> ,w< 2 > .and wo). 


55 I F ( (AD-CGEMA ) .LE.ER) GO TO 65 
PRINT 58, AD, CGEMA 
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58 F0RMAT(2X, ‘COS<BE T A*DETA)«‘ , F 1 0 • 7 , » . C05t6EMA1*‘ , F? • 7, ’ERROR* ) 

GO TO 290 
C 

60 I F ( (ABS(FA)-I .0) .GT.ER) GO To 70 
65 CETA-0.0 
GO TO 80 
70 PRINT 75 ,FA 

75 FORMAT t 2X ,* ERROR IN COSULFA)-', Fll.B) 

GO TO 290 
C 

78 I N* 2 

80 CALL CR05S(P,Q,V) 

DO 90 1*1,2 
A (1) »P ( 1 ) 

A (2 )*Q ( 1 ) 

A ( 3 I *V ( l ) 

B ( 1 ) *P ( 2 ) 

B ( 2 ) * 0 ( 2 ) 

B ( 3 ) ■ V ( 2 ) 

C 

C (1) *P ( 3 ) 

C ( 2 ) *Q ( 3 ) 

C ( 3 ) *V ( 3 ) 

D ( 1 ) sCBETA 
D (2 ) -CDETA 
D ( 3 ) *C£T A 
C 

DTA*OET ( A ,B ,C ) 

DT 1 *DET ( D ,B ,C ) 

DT2*DET t A ,0 ,C ) 

DT3*DET( A,B,D) 

W ( I ) =DT 1 /OT A 
W ( 2 ) «DT2/DTA 
W ( 3 ) *DT3/0TA 
C 

I F ( IN.EO. I ) GO TO 300 
V ( 1 ) *-V ( 1 ) 

V ( 2 ) *-V ( 2 ) 

V ( 3 ) *-V < 3 ) 

UlllsKIII 
U ( 2 ) *W ( 2 ) 

U ( 3 ) *W < 3 ) 

C 

PRINT 82,1 , U ( 1 ) , U ( 2 ) , U ( 3 l 

82 FORMAT (2X , ‘SOLUTION ',I2,‘, COMPONENTS OF SPjm AXjS ARE *,3F12.5> 
90 CONTINUE 
GO TO 500 
C 

! 00 PRINT 120 

120 FORM AT ( 2X , * SP I N Axis IS PARALLEL TO VECTOR p‘> 

IF(CBETA.GT.O.O) GO TO 130 
C 

W(l) *-P ( 1 ) 

W ( 2 ) *-P ( 2 ) 

W ( 3 ) «-P ( 3 ) 

GO TO 300 
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c 

1 30 W< ! )-P ( 1 ) 

W( 2 )-P( 2 > 

W ( 3 ) » P ( 3 ) 

GO TO 300 
C 

1 H 0 PRINT 150 

150 FORMAT ( 2 X , *SPIN Axis IS PARALLEL TO VECTOR Q * ) 
IF(CDETA.GT.O.O) GO TO 160 
W ( 1 ) »-Q ( 1 ) 

W ( 2 > *-Q ( 2 ) 

W ( 3 ) ■- 0 ( 3 ) 

GO TO 300 
C 

160 W ( I ) *Q 1 1 ) 

W < 2 ) *QC 2 > 

W ( 3 ) *Q ( 3 ) 

GO TO 300 
C 

180 IF ((ACMA- 1 , 0 ) .LE.ER) GO TO ?00 
PRINT 185 ,CGEMA 

185 FORMAT ( 2 X , ’ERROR IN COS(GEMA)-’. F 1 1 • 8 ) 

GO TO 290 

c 

200 PRINT 250 

250 F 0 RMAT( 2 X,’P ANO Q ARE PARALLEL’) 

290 I N *0 
C 

PRINT 295 , I N 

295 format ( 2 x , • i n« * , 1 2 * ' •••••no solution****** j 
GO TO 500 
c 

300 PRINT 82 , I N ,W ( 1 ) . W ( 2 ) , W ( 3 ) 

500 RETURN 

end 


SUBROUTINE CROSS (P ,0 tW ) 

P AND Q ARE DIRECTION COSINES OF TWO UNIT VECTORS 
W REPRESENTS THE UNIT VECTOR jN THE DIRECTION OF (P)X(O) 
DIMENSION P(3), 0(3) ,W<3> 

G 1 »P ( 2 ) *0 ( 3 ) -P ( 3 ) *Q ( 2 ) 

G2*P ( 3 ) *Q ( I ) -P < I ) *0 ( 3 ) 

G 3 * P ( l )*Q(2)-P(2>*Q( 1 ) 

SQ*SQRT ( G 1 *G 1 +G 2 * G 2 * G 3 • G 3 ) 

W< 1 ) * G 1 / 5 Q 
W ( 2 ) *G2 /SQ 
W(3)«G3/S0 
RETURN 
END 
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subroutine: o irc t Ra ,de ,d ) 

c 

C Ra IS the RIGHT ASCENSION. 

C OE IS THE DECLINATION. 

C RA AND DE ARE IN RADIANS, 

c DETERMINE the direction cosines 

c 

DIMENSION DO) 

D ( I ) a (COS (RA ) ) * (CoSlDE ) ) 

D ( 2 ) • ( S I N ( RA ) ) • (COSIDE)) 

DO)aSIN(OE) 

return 

END 


FUNCTION DET ( A i B, C) 

C 

DIMENSION A ( 3 ) » BO) . CO) 

c compute the determinant of 3 x 3 matrix 
CF I aR ( 2 ) *c O ) -B (3 ) *C ( 2 ) 

CF2«B O ) *C ( 1 ) -B ( l ) *C (3 ) 

CF3aB ( I ) *C ( 2 ) -B ( 2 ) *C ( 1 ) 
OETaA(l)*CFl*A(2)*CF2 + AO)*CF3 

return 

END 
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Appendix C 


FORTRAN Listing of Attitude Determination Program for IMP I 

C THIS PROGRAM IS WRITTEN TOR UNIVAC !l08 COMPUTER BY A, C. FANG 

DIMENSION P < 3 ) ,Q ! 3 > ,W i 3 ) ,U t 3 ) 

DATA RAO, TPl/n. 017^5329,6.2831 85 3/ 

DATA RE/6378.388/ 

DATA GAMAD/90,0/ 

data err ,beam/o . in ,3 .0/ 

re is the radius of the earth, err is thf error limit. 

BEAM--THE FIELD Or VIEW OF THE HORIZON SCANNER. 

SGAMA»S IN ( GAMAD«RaD ) 

CGAMA»COS(GAMAD*RaD) 

SPX-0 .0 

SPY-COS ( 66 .55-RAD ) 

SPZ«-SIN(66,55«RAd> 

SPX ,SPY ,SPZ ARE The COMPONENTS of DESIRED SPI*.' AXIS ORIENTATION. 

1 READ R , I D , 10 AY , I H , I M , I MS , I ET , I EW .SPP ,BET AD 
R FORMAT! I ) ,Ir,2I3,16,5X , 2 1 5 , 5 X , 2 F 8 , 2 ' 

IF! ID.NE.O) GO TO ISO 
TSEC-IH-3600+IM*6o + ! IMS/1000I 
EW-IEW-360/SPP-BEaM 

c spp is the spin period. 

ET«IET*36P/SPP 
BET A-BET AD*R AD 
SB-S I N ( BET A ) 

CB-COS I BET A ) 

C 

PRINT 6 
6 FORMAT I • 1 » 1 

PRINT 8,!0AY,TSEC 

8 FORMAT!//, 2X, 'TIME OF TELEMETRY DATA IS, DAY. • ,13.* SEC- *,F10.2, 

1 • — H MS • ) 

PRINT 9, SPP 

9 FORMAT t 2X ,» THE SPIN PEPIOn OF SPACECRAFT IS *,F9.2»» MSEC*) 

PRINT 10, SPX .SPY ,SP7 

10 FORMAT ( 2X , *THE DIRECTION COSINES OF DESIRED SPIN AXIS ARE *,3F9.S) 
C 

READ 1 6 ,SP ,SQ ,ST ,sx ,SY ,SZ 
PRINT 1R,SP,5Q,ST 

1R FORMAT ! 2X ,* THE COMPONENTS OF SPACECRAFT POSITION VECTOR IN K.M.ARE 
1 • ,3F18.5) 

16 format ( i 3x ,3F i 2 .3 ,3F io .7 ) 

PRINT 17,5X,SY,SZ 

17 FORMAT (2X , *THE DIRECTION COSINES OF SUN LINE VECTOR ARE *,3F15.5) 
PRINT 1 8 , BET AD 

18 F0RMAT!2X,*THE ANGLE BETWEEN THE SPIN A/lS AnD THE SUN POSITION 
1VECT0R IS*,F9.3,* DEG i • ) 
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c COMPUTE THE DIRECTION COSINE*; OF SPACECRAFT POSITION VECTOR 

SQR»SP»SP+SQ*SQ*ST*ST 

SRR«SQRT ( SQR ) 

S I «SP/SRR 
S2«SQ/5RR 
S3«ST/SRR 
C 

SR-RE/SRR 
ROM«aS IN ( SR ) 

C R * C 0 S ( ROM ) 

ROMO.ROM/RAD 
PRINT 19, EW, ROMO 

19 FORMAT (2X , ’EARTH WIDTH Is «,F9.**.’ OEG., HAuF angle SUBTENDED by 
1 EARTH is * , F 9 . *4 , • DEG,’) 

EWH«EW/2 ,0 
C E»*C05 ( EWH*R AD ) 

IF(EWH.LE.ROMD) Go TO 22 
PRINT 20 

20 FORMAT!//, 2x , • THE EARTH WIDTH IS LARGER THAN THE ANGLE SUBTENDED 
I BY TNE EARTH, NO FURTHER COMPUTATION,’) 

GO TO 1 
C 

C COMPUTE EQUATION (18) 

22 CSES»S 1 •SX+S?«SY+S3»SZ 
SESD.ACOS ( CSES ) /RAD 

Q ( l ) --S 1 
Q ( 2 ) *-S2 
Q ( 3 ) a-S3 

PRINT 23 ,Q I 1 ) ,Q ( ? ) ,0 ( 3 ) 

23 FORMAT ( 2X , ’THE DIRECTION COSINES OF DOWNWARD LOCAL vertical are *, 
1 3F 1S.S) 

C 

C CHECK the TWO REFERENCE VECTORS IF THEY ARE PARALLEL 

I F ( ABS ( CSES ) ,LT , 1 .0 ) GO TO 25 
PRINT 2*4 

2 M FORMAT ( 2X ,’ NO SOLUTION*) 

GO TO 1 
C 

25 CE «SX*Q ( ) ) ♦SY*Q ( 2 ) +S7*0 ( 3 ) 

ETA»AC05 ( CE > /RAD 
SE*SIN(ETA*RAD> 

PRINT 27, ET 

27 FORMAT 1 2 X , ’THE VIEWING ANGLE aT ThE SPACECRAFT FROM THE SUN TO THE 
1 EARTH IS ' , F 9 , 2 , • DEG,’) 

PRINT 2 8 , E T A 

28 FORMAT (2X, ’THE ANGLE BETWEEN THE SUN AND THE LOCAL VERTICAL IS ’, 
I F 9 , 2 » ’ DEG,') 

29 FORMAT I 2X , 10F I 3 ,8 ) 

C 

P< 1 )«SX 
P ( 2 ) *S Y 
P ( 3 ) »SZ 

C COMPUTE EQUATION (32) 

CKX»CE*CR 
X D ■ A C 0 5 ( CKX ) /RAD 
C 

C CHECK THE CONDITION FOR DETERMINATION OF CROSSINGS 

IF(CSES.GE.CR) GO TO 33 
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I F < CSES .GE . ( -CR ) ) GO TO 37 
PRINT 30 

30 FORMAT (// ,2y , 'THE SPACECRAFT IS IN THE EARTH SHADOW*) 
GO TO 1 


33 PRINT 3 4 

34 FORMAT (// ,2X » ‘THE FULL EARTH JS SEEN*) 

IF(GAMAD.EQ.90.0) GO TO 36 

FOR GAMaD NOT EQU A L TO 90.0, WHEN FULL EARtH IS SEEN 
ETWH« < ET + EWH ) *R AD 
CETWH*COStETWH) 

DNUM»CB*SGAMA»CEW-SR*CGAMA*CETWH 

IF(DNUM.EO.O.C) GO TO 49 
COMPUTE EQUATION (2R> 

DETA«ATAN?( (CR»CR-CGAMA»CE) ,(CE*SGAMA«CEw-CR*s8«CETWH| I 
GO TO 39 

FOR GAMAD EQUAL To 90.0, WHpN FU^L EARTH IS SEEN 
COMPUTE EQUATION (2*0 

36 SDTA-CR/CEW 
DET A«AS IN ( SOTA ) 

39 DETAD*OETA/RAD 
JS* 1 

GO TO 54 

37 PRINT 38 

38 FORMAT (// ,2X ,* AN EARTH TERMINATOR IS VISIBLE*) 

C CHECK THE VIEWING ANGLE, WHEN TERM|NATOR IS VISIBLE 

I F ( ET .LT . I BO .0 ) Go TO 4 3 
C 

EC* ( ET + EW > *R AO 
C A a C 0 S (TP I-EC ) 

SA»SIN(TPI-EC) 

GO TO 45 
C 

43 CA*COS ( ET«RAD ) 

SA»SIN(ET«RAOI 
C COMPUTE EQUATION (30) 

45 CK1»CB*CGAMA+SB.SC,AMA.CA 
ERMeCOSt (FTA-ROMO)*RAO) 

IF (CKl.LT.ERM)GO TO 48 

I F ( ABS ( CK 1 -ERM ) ,LT .FRR ) Go TO 50 
C 

PRINT 46.CK1 ,ERM 

46 FORMAT (/, 2X , ‘ERROR IN CK1**,F5.2,* FPM»*,F6.?) 

49 PRINT 47 

47 FORM AT ( 2X , • ERROR , NO SOLUTION*) 

GO TO 1 

C 

4 R I F ( CK 1 . GE ,CKX ) GO TO 50 

I F ( ABS ( CK 1 -CKX ) ,LT .ERR I GO To 50 
PRINT 47 
GO TO 1 
C 

50 SK I = S Q R T ( ! .O-CK 1 «CK ) ) 
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CKO 1 »ACOS ( CK I ) / RAO 

c compute equation (3h> 

CEK1»(CR-CKJ*CE)/(SKI*SE> 

SGL«CEK 1 / ftBS ( CEK 1 ) 

I F ( A85 ( CEK 1 ) . GT . 1 , O ) CEKl«SGu 
EK I *ACOS (CEK l ) /RAr> 

C COMPUTE EQUATION ( 35 I 

SEO* A S I N ( SR/SE ) /RAO 
IEIEK1 .LE.SEO) GO TO Si 

IF ( ABS (EK I -SEO ) ,t-T . ( ERR »5 .0 > ) GO TO SI 
PRINT 8 7 
GO TO 1 
C 

C COMPUTE EQUATION (33) 

SI S8K*S AjSGAMA /5K 1 

I E ( 5 Ft K .GT. 1 .0 ) SRK » 1 ,n 
BK« ( AS I N (SBK ) ) / R A rt 
BEA»(BK+EK11*RA0 
BEB* ( BK-EK 1 ) • R A n 

C COMPUTE EQUATION (37) A N 0 ( 3 « } 

CnTA|«Cb«CE*SB»SE*COS(BEA) 

C0TA?=CB*CE*SB»SE»C05(BEB) 

c 

S 2 OTA 1 «=ACOS ( COT A 1 ) 

DTA? = ACOS ( C 0 T A 2 ) 

DOAlsOTA 1 /RaO 
OOA2»OT A?/R AO 
JS«2 

I F ( CDT A l .ME .COT A? ) GO TO S3 
JS* 1 

S3 OE T A »DT A ! 

PRINT 73, JS 
C 

SB TMAXsO.O 

00 58 I a 1 , JS 
PRINT 78,! 

PRINT S 7 

CALL SPIN(P,Q,BETa,OETA,WI,U,Tm) 

I E ( TN.EQ.O) GO TO 1 
R 1 *W ( 1 ) 

R 2 * A ( 2 ) 

R3*'A ( 3 ) 

C 

C COMPARE EACH SOLUTION OE SPIN AXIS 'VITh THE OFSIREO ORIENTATION. 

DO 56 J* 1 , IN 

TE5Tc«SPX*R!+SPY*r?+SP7*R3 
IE(TESTC.LT.TMAX) GO TO 5S 
TMAX=TESTC 
PP 1 *R 1 
Pp 2 * R 2 
P P 3 * R 3 
S 5 R 1 =U ( I ) 

R2*U ( 2 ) 

R3*U ( 3 ) 

5 6 CONTINUE 
C 

PRINT 57 

57 EORM AT ( 2 X , * « * > 
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D E T A = D T A 2 
5 8 CONTINUE 

C COMPUTE THE RIGHT ASCENSION AMD DfCLINATION of SELECTED SOLUTION. 

R A * A T A N 2 ( PP2 ,PP 1 > 

DA=AS!N(PP3J/RAD 
IF (RA.GE.O.O) GO TO 70 
RA = R A+6 . 2831853 
70 RA=RA/RAD 
C 

PRINT 72. R1 , R 2 » R 3 

72 FORMAT (2X, ‘FINAL SELECTION Of THE SPIN AXIS ORIENTATION WITH 
1 COMPONENTS * , 3 F 1 2 , 5 ) 

73 FORMAT ( 2X , *THE SCANNER CUTS THE EARTH HORIZON AT * . I 3 , • POINT') 

7<i format ( ' 0 * ,• •••••••••••••••output for point* , i 3 ,'••••••*•••**•••• ) 

PRINT 78.RA.PA 

78 FORMAT I2X , 'RIGHT ASCENSION AND DECLINATION OF 5PIN AXIS ARE ', 

1 F 1 H . 3 , ' DEG. , *.F1R»3»* DEG,') 

PRINT S 7 
GO TO 1 
150 END 
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Appendix D 


Sample of Attitude Determination Output 



NASA-Langley, 1972 


W TjHE nr TELEMETRY DATA is, day* 76 SEC* 61395*00 -H M S 

° THE SPIN PER100 OF SPACECRAFT Is 11133,75 MSEC 

THE DIRECTION COSINES OF OESIREd SPIN AXIS ARE .00000 ,39795 -.917*41 

THE COMPONENTS OF SPACECRAFT POSITION VECTOR IN K • M • A R E *4700 1 .58 105 305q9, 70703 10676,79199 

THE DIRECTION COSINES OF SUN LINE VECTOR ARE .9937 1 -.056*46 -.02*4*49 

THE ANGLE BETWEEN THE SPIN AXIS AND THE SUN POSITION VECTOR IS 89,200 DEG, 
earth width is 6.9589 deg,, half angle subtended by earth is 6.4101 deg. 

The DIRECTION COSINES of downward LOCAL VERTICAL ARE -.02410 -.53*473 -. 1 8608 

the VIEWING ANGLE AT THE SPACECRAFT FROM ThE SUN TO THE EARTH IS 136,22 DEG. 

THE ANGLE BETWEEN THE SUN AND ThE LOCAL VERTICAL IS 14|.60 DEG, 


an earth terminator is visible 

The scanner cuts THE earth horizon AT 2 POINT 


OUTPUT FOR POINT 1 


ANGLE BETWEEN TWO GIVEN VECTORS 

p AND Q 

ARE 

1 4 1 .60427 



SOLUT I ON 

1 , components of spin 

AXIS ARE 


.01470 

.40734 

-.91320 

SOLUTION 

* 

2 , components of spin 

AXIS ARE 


.02297 

-.26177 

.9640? 




*•**« 

► • * • 



ANGLE BETWEEN TWO GIVEN VECTORS 

P AND Q 

ARE 

1 4 1 ,60427 



SOLUTION 

1 , COMPONENTS OF SPIN 

AXIS ARE 


.00323 

.23145 

- .97296 

SOLUTION 

2 , components of spin 

AXIS ARE 


.01147 

-.43586 

•90007 

final selection of the spin axis 

orientation 

WITH COMPONENTS 

,00323 ,23145 

right ascension and DECLINATION 

OF SPIN 

AXIS 

ARE 

87.933 OEG. 

-65.951 OEG, 


-•97296 


TtME nF TFlEmFTrY DATA is, day* 76 SPC* 62050.no -H M S 
The SPIN PFRinn OF SPACFCRAFT ts 11173,75 MSEC 

The DIRECTION COSINES OF OESIREd SPIN AXIS ARE .00000 ,39795 -,91 7*4 1 

The COMPONENTS OF SPACECRAFT POSITION VECTOR IN K.M.ARE *451 09.67578 30155.7629*4 9937.02300 

THE DIRECTION COSINES OF SUN LImF VFC t OR ARE .99372 -.0563*4 -.02*443 

The ANGLF between THE SPIN AXIS AND THF SUN POSITION VECTOR Is 89,200 DE6. 

Earth wtDTH is 6.6333 OEG • * HALF angle SUHTTNOeD BY FapTH IS 6.6398 deg. 

The DIRECTION COSINES OF DOWNWARD LOCAL VERTICAL are -.0 1 77*4 -.54666 -.|8015 

the VIFYING a K1 G L E at the SPACECoaFT from THF SUN to THE Earth is 1 35,77 DEG. 

The ANGLE 0ET'*EEN THC sun AND The LOCAL VERTICAL IS 14?. 99 DEG. 


am earth terminator is visible 

The SCANNFR cuts The earth MORIZON at 2 POINT 

**•#•••*«. •««*0|JTPUT for POINT l ***•*«•*•«****• 

* 

ANGLE B E T E E M TWO GIVEN VECTORS P A N o Q ARE 140.987 1 ? 

SOLUTION 1, COMPONENTS QF SPIN Axis APE .DM64 .40654 -.9 1 357 

SOLUTION 7, COMPONENTS OF 5PM AXIS ARE .07497 -.230*40 .9728 1 


••••••••• OUTPUT FOR POINT ?••*•******* 

* 

ANGLE BETWEEN TWO GIVEN VECTORS p AND R ARF 
SOLUTION I, COMPONENTS OF SPIN AXIS A p E 
SOLUTION 7, COMPONENTS OF SPIN AXIS APE 

• 

FINAL SELFcTION of the spin axis orientation 
RIGHT ASCENSION and DECLINATION of SPIN AXIS 


1 40.9871 2 

.00132 .700*U -.97985 

.01156 -.43464 .90068 


UTH 




COMPONENTS 


.00132 


.20041 


-.97985 
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